|
| | CaptureOdom3d (const TimeStamp &_init_ts, SensorBasePtr _sensor_ptr, const Eigen::VectorXd &_data, CaptureBasePtr _capture_origin_ptr=nullptr) |
| |
| | CaptureOdom3d (const TimeStamp &_init_ts, SensorBasePtr _sensor_ptr, const Eigen::VectorXd &_data, const Eigen::MatrixXd &_data_cov, CaptureBasePtr _capture_origin_ptr=nullptr) |
| |
| | ~CaptureOdom3d () override |
| |
| | CaptureMotion (const std::string &_type, const TimeStamp &_ts, SensorBasePtr _sensor_ptr, const Eigen::VectorXd &_data, CaptureBasePtr _capture_origin_ptr, const TypeComposite &_state_types={}, const VectorComposite &_state_vectors={}, const PriorComposite &_state_priors={}) |
| |
| | CaptureMotion (const std::string &_type, const TimeStamp &_ts, SensorBasePtr _sensor_ptr, const Eigen::VectorXd &_data, const Eigen::MatrixXd &_data_cov, CaptureBasePtr _capture_origin_ptr, const TypeComposite &_state_types={}, const VectorComposite &_state_vectors={}, const PriorComposite &_state_priors={}) |
| |
| | ~CaptureMotion () override |
| |
| bool | isMotion () const override |
| | Is a motion if there is motion detected. More...
|
| |
| const Eigen::VectorXd & | getData () const |
| |
| const Eigen::MatrixXd & | getDataCovariance () const |
| |
| void | setData (const Eigen::VectorXd &_data) |
| |
| void | setDataCovariance (const Eigen::MatrixXd &_data_cov) |
| |
| MotionBuffer & | getBuffer () |
| |
| const MotionBuffer & | getBuffer () const |
| |
| Eigen::VectorXd | getCalibrationPreint () const |
| |
| void | setCalibrationPreint (const Eigen::VectorXd &_calib_preint) |
| |
| Eigen::MatrixXd | getJacobianCalib () const |
| |
| Eigen::MatrixXd | getJacobianCalib (const TimeStamp &_ts) const |
| |
| Eigen::VectorXd | getDeltaPreint () const |
| |
| Eigen::VectorXd | getDeltaPreint (const TimeStamp &_ts) const |
| |
| Eigen::MatrixXd | getDeltaPreintCov () const |
| |
| Eigen::MatrixXd | getDeltaPreintCov (const TimeStamp &_ts) const |
| |
| CaptureBasePtr | getOriginCapture () |
| |
| CaptureBaseConstPtr | getOriginCapture () const |
| |
| void | setOriginCapture (CaptureBasePtr _capture_origin_ptr) |
| |
| bool | containsTimeStamp (const TimeStamp &_ts, double _time_tolerance) const |
| |
| void | printHeader (int depth, bool factored_by, bool metric, bool state_blocks, std::ostream &stream, std::string _tabs="") const override |
| | Print the header information of the capture. More...
|
| |
| | CaptureBase (const std::string &_type, const TimeStamp &_ts, SensorBasePtr _sensor_ptr=nullptr, const TypeComposite &_state_types={}, const VectorComposite &_state_vectors={}, const PriorComposite &_state_priors={}) |
| | Constructor. More...
|
| |
| | ~CaptureBase () override=default |
| |
| void | remove (bool viral_remove_parent_without_children=false) override |
| | Remove the capture. More...
|
| |
| bool | hasChildren () const override |
| | Check if the capture has any children. More...
|
| |
| virtual FactorBasePtr | emplaceDriftFactor (CaptureBasePtr _capture_origin, char _key, bool _apply_loss_function) |
| | Emplace a FactorBlockDifference with zero difference between the state _key of this capture and _capture_origin. More...
|
| |
| virtual bool | isMotion () const |
| | Is a motion if there is motion detected. More...
|
| |
| bool | process () |
| | Process the capture. More...
|
| |
| unsigned int | id () const override |
| |
| TimeStamp | getTimeStamp () const |
| |
| void | setTimeStamp (const TimeStamp &_ts) |
| |
| void | setTimeStampToNow () |
| |
| FrameBaseConstPtr | getFrame () const |
| |
| FrameBasePtr | getFrame () |
| |
| FeatureBaseConstPtrList | getFeatureList () const |
| |
| FeatureBasePtrList | getFeatureList () |
| |
| bool | hasFeature (const FeatureBaseConstPtr &_feature) const |
| |
| FactorBaseConstPtrList | getFactorList () const |
| |
| FactorBasePtrList | getFactorList () |
| |
| void | getFactorList (FactorBaseConstPtrList &_fac_list) const |
| |
| void | getFactorList (FactorBasePtrList &_fac_list) |
| |
| SensorBaseConstPtr | getSensor () const |
| |
| SensorBasePtr | getSensor () |
| |
| virtual void | setSensor (const SensorBasePtr sensor_ptr) |
| |
| StateBlockConstPtr | getStateBlock (const char &_key) const override |
| |
| StateBlockPtr | getStateBlock (const char &_key) override |
| |
| StateBlockConstPtr | getSensorP () const |
| |
| StateBlockPtr | getSensorP () |
| |
| StateBlockConstPtr | getSensorO () const |
| |
| StateBlockPtr | getSensorO () |
| |
| StateBlockConstPtr | getSensorIntrinsic () const |
| |
| StateBlockPtr | getSensorIntrinsic () |
| |
| void | fix () override |
| |
| void | unfix () override |
| |
| void | link (FrameBasePtr _frm_ptr) |
| | Link the capture to a frame. More...
|
| |
| virtual void | printHeader (int depth, bool factored_by, bool metric, bool state_blocks, std::ostream &stream, std::string _tabs="") const |
| | Print the header information of the capture. More...
|
| |
| void | print (int depth, bool factored_by, bool metric, bool state_blocks, std::ostream &stream=std::cout, std::string _tabs="") const |
| | Print the capture details. More...
|
| |
| virtual CheckLog | localCheck (bool _verbose, std::ostream &_stream, std::string _tabs="") const |
| | Perform a local check on the capture. More...
|
| |
| bool | check (CheckLog &_log, bool _verbose, std::ostream &_stream, std::string _tabs="") const |
| | Check the capture. More...
|
| |
| CaptureBasePtr | shared_from_this_capture () |
| |
| CaptureBaseConstPtr | shared_from_this_capture () const |
| |
| | NodeStateBlocks (const std::string &_category, const std::string &_type, const TypeComposite &_state_types, const VectorComposite &_state_vectors, const PriorComposite &_state_priors) |
| | Constructor. More...
|
| |
| virtual | ~NodeStateBlocks () |
| |
| virtual YAML::Node | toYaml () const |
| |
| StateKeys | getKeys () const |
| |
| TypeComposite | getStateTypes () const |
| |
| bool | has (const char &_sb_key) const |
| |
| bool | has (const std::string &_keys) const |
| |
| virtual unsigned int | id () const =0 |
| |
| std::map< char, StateBlockConstPtr > | getStateBlockMap () const |
| |
| std::map< char, StateBlockPtr > | getStateBlockMap () |
| |
| std::vector< StateBlockConstPtr > | getStateBlockVec () const |
| |
| std::vector< StateBlockPtr > | getStateBlockVec () |
| |
| StateBlockConstPtr | getP () const |
| |
| StateBlockConstPtr | getO () const |
| |
| StateBlockPtr | getP () |
| |
| StateBlockPtr | getO () |
| |
| virtual void | fix () |
| |
| virtual void | unfix () |
| |
| virtual bool | isFixed () const |
| |
| StateBlockPtr | emplaceStateBlock (const char key, const std::string &_type, const Eigen::VectorXd &_vector, const bool &_fixed) |
| | Emplace a state block. More...
|
| |
| StateBlockPtr | emplaceStateBlockZero (const char key, const std::string &_type, const bool &_fixed) |
| | Emplace a state block with zero state. More...
|
| |
| bool | hasStateBlock (const StateBlockConstPtr &_sb) const |
| |
| bool | setStateBlock (const char _sb_key, const StateBlockPtr &_sb) |
| |
| bool | stateBlockKey (const StateBlockConstPtr &_sb, char &_key) const |
| |
| virtual StateBlockConstPtr | getStateBlock (const char &_sb_key) const |
| |
| virtual StateBlockPtr | getStateBlock (const char &_sb_key) |
| |
| void | setProblem (ProblemPtr _problem) override |
| |
| virtual void | remove (bool viral_remove_parent_without_children=false) |
| |
| bool | hasChildren () const override |
| |
| void | emplaceFactorStateBlock (const char &_key, const Eigen::VectorXd &_x, const Eigen::MatrixXd &_cov, unsigned int _start_idx=0) |
| | Add an absolute factor to a parameter. More...
|
| |
| void | emplacePriors () |
| |
| FactorBaseConstPtrSet | getFactoredBySet () const |
| |
| FactorBasePtrSet | getFactoredBySet () |
| |
| void | getFactoredBySet (FactorBaseConstPtrSet &_fac_set) const |
| |
| void | getFactoredBySet (FactorBasePtrSet &_fac_set) |
| |
| FactorBaseConstPtrSet | getSensoryFactorSet () const |
| |
| FactorBasePtrSet | getSensoryFactorSet () |
| |
| std::map< char, FactorBaseConstPtr > | getPriorFactorMap () const |
| |
| std::map< char, FactorBasePtr > | getPriorFactorMap () |
| |
| FactorBaseConstPtr | getPriorFactor (char) const |
| |
| FactorBasePtr | getPriorFactor (char) |
| |
| FactorBaseConstPtrList | getFactorsOf (ProcessorBaseConstPtr _processor_ptr, const std::string &type="") const |
| |
| FactorBasePtrList | getFactorsOf (ProcessorBasePtr _processor_ptr, const std::string &type="") |
| |
| bool | hasFactor (FactorBaseConstPtr _fac) const |
| |
| VectorComposite | getState (const StateKeys &_keys="") const |
| |
| void | setState (const VectorComposite &_state, const bool _notify=true) |
| |
| void | setState (const Eigen::VectorXd &_state, const StateKeys &_keys, const std::list< SizeEigen > &_sizes, const bool _notify=true) |
| |
| void | setState (const Eigen::VectorXd &_state, const StateKeys &_keys, const bool _notify=true) |
| |
| void | setState (const StateKeys &_keys, const std::list< Eigen::VectorXd > &_vectors, const bool _notify=true) |
| |
| Eigen::VectorXd | getStateVector (const StateKeys &_keys) const |
| |
| unsigned int | getSize (const StateKeys &_keys="") const |
| |
| unsigned int | getLocalSize (const StateKeys &_keys="") const |
| |
| bool | getCovariance (const StateKeys &_keys, Eigen::MatrixXd &_cov) const |
| |
| void | perturb (double amplitude=0.01) |
| | perturb all states states with random noise following an uniform distribution in [ -amplitude, amplitude ] More...
|
| |
| bool | isCapture () const |
| |
| bool | isFrame () const |
| |
| bool | isLandmark () const |
| |
| bool | isSensor () const |
| |
| | NodeBase (const std::string &_category, const std::string &_type="Undefined", const std::string &_name="") |
| |
| virtual | ~NodeBase ()=default |
| |
| unsigned int | nodeId () const |
| |
| std::string | getCategory () const |
| |
| std::string | getType () const |
| |
| std::string | getName () const |
| |
| bool | isRemoving () const |
| |
| virtual bool | hasChildren () const =0 |
| |
| void | setType (const std::string &_type) |
| |
| void | setName (const std::string &_name) |
| |
| ProblemConstPtr | getProblem () const |
| |
| ProblemPtr | getProblem () |
| |